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SPECIFICATION 
LEGGED MOBILE ROBOT AND 
FLOOR REACTION FORCE DETECTION SYSTEM THEREOF 

TECHNICAL FIELD TO WHICH THE INVENTION RELATES TO 

This invention relates to a legged mobile robot and a floor reaction force 
detection system thereof 

BACKGROUND ART OF THE INVENTION 

In legged mobile robots, in particular, in biped mobile robots of 
humanoid type, a sensor is installed at each foot to detect displacement of the foot at 
foot landing or floor reaction force acting on the robot from a floor surface which 
the robot contacts and beised on the detected values, control is appropriately 
performed to achieve stable walking. 

Japanese Laid-Open Patent Application No. Hei 5(1993)-305584 
proposes a technique to install the floor reaction force sensor at each robot foot. In 
the prior art, a six-axis force sensor is installed between an ankle joint and a floor 
contact end of each foot of a biped mobile robot of humanoid type to detect the floor 
reaction force acting on the foot. 

Further, Journal of the Robotics Society of Japan Vol.13, No.7, pp. 1030 
- 1037 (October, 1995) proposes a technique to install a displacement sensor 
detecting the displacement of the feet. In the prior art, a foot of a similar legged 
mobile robot is made of an upper foot plate and a lower foot plate connected by wire 
to sandwich a shock absorber therebetween. Sensing elements, partial components 
of potentiometers (displacement sensors), are disposed at four comers of the upper 
foot plate, and a converter is installed at its upstream such that distance 
(displacement) between the upper and lower foot plates is detected through the 
sensing elements. In this manner, it is detected whether the foot has landed and there 
is a height difference (irregularity) at a landed floor area. 

In the feet of the legged mobile robots, in particular, of the biped mobile 
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robots of humanoid type, it is necessary to install an appropriate guide member to 
prevent the supporting leg from spinning about the vertical axis due to reaction force 
of swinging the free leg during robot walking. At the same time, the feet must have 
certain elasticity to absorb and mitigate the impact at foot landing of the free leg. 
5 When the sensor is thus installed at each foot of the legged mobile robot, 

in particular, of the biped mobile robots of humanoid type, since space at the feet is 
limited, only the sensing elements, a partial component of the sensor, are disposed at 
an elastic member. However, displacement sensors should preferably include the 
other components such as a converter or the like and be compact enough to be 
10 installed there. 

DISCLOSURE OF THE INVENTION 
A first object of the invention is to eliminate the drawbacks of the 
above-mentioned prior art, and to provide a legged mobile robot, in which a sensor 
including its component such as a converter or the like is made compact enough to 
15 be housed in elastic members at a limited space of each foot of a legged mobile 

robot. 

Further, when a sensor is installed at each foot of the legged mobile 
robot, since it is exposed to the impact at foot landing as mentioned above, in order 
to improve the detection accuracy, it is preferable to self-diagnose abnormality of 
20 the sensor. 

A second object of the invention is, therefore, to provide a legged mobile 
robot, in which the sensor is installed at each foot of the legged mobile robot and 
abnormality of the sensor can be self-diagnosed to improve reliability. 

Further, for achieving more stable walking of the legged mobile robot, in 
25 addition to detecting the presence or absence of foot landing, it is preferable to 

detect a floor reaction force acting on the foot. 

A third object of the invention is, therefore, to provide a floor reaction 
force detection system of a legged mobile robot, in which a displacement sqnsor is 
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installed at the foot of the legged mobile robot such that the floor reaction force 
acting on the foot can be detected based on an output thereof. 

In order to achieve the first object, as recited in claim 1 mentioned below, 
the invention provides a legged mobile robot having at least a body and a plurality 
5 of legs each connected to the body through a first joint and each having a foot 

connected to a distal end of the leg through a second joint, comprising: an elastic 
member installed at a position between the second joint and a floor contact end of 
the foot; and a displacement sensor installed in a space defined by a top-to-bottom 
height of the elastic member such that a displacement of the floor contact end of the 

10 foot relative to the second joint can be detected. Thus, since it is arranged such that 

an elastic member is installed at a position between the second joint and a floor 
contact end of the foot and a displacement sensor is installed in a space defined by a 
top-to-bottpm height of the elastic member such that a displacement of the floor 
contact end of the foot relative to the second joint can be detected, it becomes 

15 possible to dispose the sensor including its components such as a converter or the 

like is made enough to be housed in the elastic member at a limited space of the foot 
of the legged mobile robot. 

As recited in claim 2 mentioned below, the invention is arranged such 
that a plurality of the elastic members are installed at the position between the 

20 second joint and the floor contact end of the foot, at separate locations viewed fi-om 

top. Since it is arranged such that such that a plurality of the elastic members are 
installed at the position between the second joint and the floor contact end of the 
foot, at separate locations viewed fi^om top, it becomes possible to make the sensor 
compact enough to be housed in the elastic member at the limited space of each foot 

25 of the legged mobile robot and to optimize elasticity of the foot. In other words, the 

foot of the legged mobile robot should preferably have appropriate elasticity for both 
of the bending (rotational) direction and up-and-down direction. However, if the 
elastic members are unevenly gathered about the center of the foot, for instance, the 
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requirements contradict and it becomes difficult to satisfy both of the requirements. 
If the elastic members are installed at separate locations viewed from top, e.g., near 
the edge (periphery) of the foot, the contradicted requirements can be achieved by 
the above-mentioned configuration. 

As recited in claim 3 mentioned below, the invention is arranged such 
that the displacement sensor is housed in the elastic members such that the 
displacement of the floor contact end of the foot relative to the second joint can be 
detected. Since it is arranged such that the displacement sensor, more specifically 
the displacement sensor having a sensing element and the converter, is housed in the 
elastic members and the displacement of the floor contact end of the foot relative to 
the second joint can be detected, it becomes possible to make the sensor including 
its component such as the converter or the like compact enough to be housed in the 
elastic member at the limited space of the foot of the legged mobile robot. 

As recited in claim 4 mentioned below, the invention is arranged such 
that the displacement sensor is provided in vicinity of the elastic members such that 
the displacement of the floor contact end of the foot relative to the second joint can 
be detected. Since it is arranged such that the displacement sensor, more specifically 
the displacement sensor having the sensing element and the converter, is provided in 
vicinity of the elastic members such that the displacement of the floor contact end of 
the foot relative to the second joint can be detected, similarly it becomes possible to 
make the sensor including its component such as the converter or the like compact 
enough to be housed in the elastic member at the limited space of the foot of the 
legged mobile robot. 

As recited in claim 5 mentioned below, the invention is arranged such 
that a plurality of the elastic members are located at an edge of the foot when viewed 
from top. Since it is arranged such that a plurality of the elastic members are located 
at an edge (periphery) of the foot when viewed from top, the contradicted 
requirements can be achieved by the above-mentioned configuration and elasticity 



of the foot can be optimized. 

As recited in claim 6 mentioned below, the invention is arranged such 
that the displacement sensor is housed in a sealed space. Since it is arranged such 
that the displacement sensor is housed in a sealed space, in addition to the effect 
5 mentioned above, it makes possible to prevent the displacement sensor from 

adhering or intruding of foreign substances such as liquid or dust, thereby enabling 
to enhance the durability of the displacement sensors. Moreover, since the sensor is 
less likely to be influenced from the ambient temperature, it becomes possible to 
decrease the necessity of correction, e.g., temperature compensation. 

10 As recited in claim 7 mentioned below, the invention is arranged such 

that the displacement sensor comprises a spring and a pressure-sensitivity sensor. 
Since it is arranged such that the displacement sensor comprises a spring and a 
pressure-sensitivity sensor, it becomes possible to make the stmcture of the sensor 
more compact compared to the case of detecting from the normal displacement 

15 (stroke). 

As recited in claim 8 mentioned below, the invention is arranged such 
that rigidity of the spring is set to be lower than that of the elastic member. Since it 
is arranged such that rigidity of the spring is set to be lower than that of the elastic 
member, in addition to the effect mentioned above, it becomes possible to prevent 

20 the function of the eleistic member to attenuate oscillation from being degraded. 

As recited in claim 9 mentioned below, the invention provides a legged 
mobile robot having at least a body and a plurality of legs each connected to the 
body through a first joint and each having a foot connected to a distal end of the leg 
through a second joint, comprising: a plurality of displacement sensors installed in a 

25 space defined by a first rigid member cormected to the second joint and a second 

rigid member connected to a floor contact end of the foot at locations spaced apart 
with each other when viewed from top, and producing outputs indicative of a 
displacement of the floor contact end of the foot relative to the second joint; a 
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discriminator discriminating whether the outputs of the displacement sensors satisfy 
a predetermined geometric relationship; and a self-diagnoser self-diagnosing 
whether at least one of the displacement sensors is abnormal based on a 
discrimination result of the discriminator. Thus, it is arranged to discriminate 
5 whether the outputs of the displacement sensors that are installed in a space defined 

by a first rigid member and a second rigid member at locations spaced apart with 
each other when viewed fi-om top satisfy a predetermined geometric relationship, 
and to self-diagnose whether at least one of the displacement sensors is abnormal 
based on the discrimination result, i.e., since it is arranged to self-diagnose 
10 abnormality of the displacement sensors by utilizing the redundancy of freedom, it 

becomes possible to improve the detection accuracy even when the sensor is 
installed at foot of the legged mobile robot that is exposed to the impact at foot 
landing. 

As recited in claim 10 mentioned below, the invention is arranged such 
15 that the geometric relationship is a relationship in which a value calculated from the 

outputs of the displacement sensors located at opposite positions is a predetermined 
value. Since it is arranged such that the geometric relationship is a relationship in 
which a difference between the outputs of the displacement sensors located at 
opposite positions is a predetermined value, it becomes possible to self-diagnose 
20 whether the displacement sensors are abnormal easily and promptly, thereby 

enhancing the detection accuracy. 

As recited in claim 1 1 mentioned below, the invention is arranged such 
that the predetermined value is zero or a value close thereto. Since it is arranged 
such that the predetermined value is zero or a value close thereto, it becomes 
25 possible to self-diagnose whether the displacement sensors are abnormal easily and 

promptly, thereby enhancing the detection accuracy. 

As recited in claim 12 mentioned below, the invention is arranged such 
that a plurality of the elastic members are installed in the space defined by the first 
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and second rigid members at separate location when viewed from top, and the 
displacement sensors are each housed in the elastic members. Since it is arranged 
such that a plurality of the elastic members are installed in the space defined by the 
first and second rigid members at separate location when viewed from top, and that 
5 the displacement sensors are each housed in the elastic members, in addition to the 

effect mentioned with reference to the above-mentioned claim, it becomes possible 
to house the displacement sensors enough compact at the limited space of the foot of 
the legged mobile robot. 

As recited in claim 13 mentioned below, the invention is arranged such 

10 that a plurality of the elastic members are installed in the space defined by the first 

and second rigid members at separate location when viewed from top, and that the 
displacement sensors are installed in vicinity of the elastic members. Since it is 
arranged such that a plurality of the elastic members are installed in the space 
defined by the first and secoiid rigid members at separate location when viewed 

15 from top, and the displacement sensors are installed in vicinity of the elastic 

members, in addition to the effect mentioned with reference to the above-mentioned 
claim, it similarly becomes possible to make the displacement sensors compact 
enough to be housed at the limited space of the foot of the legged mobile robot. 

As recited in claim 14 mentioned below, the invention is arranged such 

20 that the displacement sensors each comprises a spring and a pressure-sensitivity 

sensor. Since it is arranged such that the displacement sensors each comprises a 
spring and a pressure-sensitivity sensor^ in addition to the effect mentioned with 
reference to the above-mentioned claim, the structure of the sensor can be made 
fiirther compact. 

25 As recited in claim 1 5 mentioned below, the invention is arranged such 

that rigidity of the spring is set to be lower than that of an elastic member. Since it is 
arranged such that rigidity of the spring is set to be lower than that of an elastic 
member, in addition to the effect mentioned with reference to the above-mentioned 
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claim, it becomes possible to prevent the function of the elastic member to attenuate 
oscillation from being degraded. 

As recited in claim 16 mentioned below, the invention provides a legged 
mobile robot having at least a body and a plurality of legs each connected to the 
body through a first joint and each having a foot connected to a distal end of the leg 
through a second joint, comprising: a displacement sensor installed at a position in 
or adjacent to an elastic member positioned between the second joint and the foot 
and producing an output indicative of a displacement of the floor contact end of the 
foot relative to the second joint; and a floor reaction force calculator calculating the 
floor reaction forces acting on the foot based on the output of the displacement 
sensor. Thus, since it is arranged to install a displacement sensor producing an 
output indicative of a displacement of the floor contact end of the foot relative to the 
second joint such that a floor reaction force calculator calculates the floor reaction 
forces acting on the foot based on the output of the displacement sensor, it becomes 
possible to calculate the floor reaction force accurately, thereby enabling to control 
the legged mobile robot to walk more stably. 

BRIEF DESCRIPTION OF THE DRAWINGS 

FIG. 1 is an explanatory perspective view showing an overall 
configuration of a legged mobile robot and a floor reaction force detection system 
thereof according to an embodiment of the invention; 

FIG. 2 is a cross-sectional side view showing the structure of a foot of 
the legged mobile robot illustrated in FIG. 1; 

FIG. 3 is a bottom view showing the foot illustrated in FIG. 2; 

FIG. 4 is an enlarged partial cross-sectional view showing a portion of 
the foot illustrated in FIG. 2; 

FIG. 5 is a flow chart showing the operation of detecting abnormality or 
malfunction (i.e., self-diagnosing) of a displacement sensor illustrated in FIG. 2, in 
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the operation of the legged mobile robot and the floor reaction force detection 
system thereof, according to a second embodiment of the invention; 

FIG. 6 is an explanatory view showing a model approximating a 
characteristic of a cylindrical rubber member (elastic member), used for floor 
5 reaction force estimation by the displacement sensor illustrated in FIG. 2, in the 

operation of the legged mobile robot and the floor reaction force detection system 
thereof according to a third embodiment of the invention; 

FIG. 7 is a schematic view of the foot illustrated in FIG, 2, explaining 
the floor reaction force estimation based on an output of the displacement sensor in 
10 the operation of the legged mobile robot and the floor reaction force detection 

system thereof according to the third embodiment; 

FIG. 8 is a block diagram showing input/output relation of a spring 
mechanism model used for the floor reaction force estimation based on an output of 
the displacement sensor in the operation of the legged mobile robot and the floor 
15 reaction force detection system thereof according to the third embodiment; 

FIG. 9 is a flow chart showing the operation of detecting abnormality or 
malfunction (i.e., self-diagnosing) of the displacement sensor and a six-axis force 
sensor in the operation of the legged mobile robot and the floor reaction detection 
system thereof, according to the third embodiment; 
20 FIG. 10 is a view, similar to FIG. 3, but showing a legged mobile robot 

and a floor reaction force detection system according to a fourth embodiment of the 
invention, specifically the configuration of a left foot 22L of feet 22R, L of the 
legged mobile robot; 

FIG. 1 1 is a view, similar to FIG. 3, but showing a legged mobile robot 
25 and a floor reaction force detection system according to a fifth embodiment of the 

invention, specifically the configuration of a left foot 22L of feet 22R, L of the 
legged mobile robot; 

FIG. 12 is a view, similar to FIG. 2, but showing a legged mobile robot 
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and a floor reaction force detection system according to a sixth embodiment of the 
invention; 

FIG. 13 is a schematic bottom view of a foot illustrated in FIG. 12; 

FIG. 14 is a schematic bottom view of the foot showing an alteration of 
a legged mobile robot and a floor reaction force detection system according to the 
sixth embodiment; 

FIG. 15 is a schematic bottom view of the foot showing another 
alteration of a legged mobile robot and a floor reaction force detection system 
according to the sixth embodiment; 

FIG. 16 is a view, similar to FIG. 2, but showing a legged mobile robot 
and a floor reaction force detection system according to a seventh embodiment of 
the invention; 

FIG. 17 is an explanatory view showing the configuration of a legged 
mobile robot and a floor reaction force detection system according to an eighth 
embodiment of the invention; 

FIG. 1 8 is a flow chart showing the operation of a legged mobile robot 
and a floor reaction force detection system according to the eighth embodiment; 

FIG. 19 is an explanatory view showing the configuration of a legged 
mobile robot and a floor reaction force detection system according to a ninth 
embodiment of the invention; and 

FIG. 20 is an explanatory view showing the structure of a 
parameter-standardizing process block illustrated in FIG. 19, in detail. 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 

A legged mobile robot and a floor reaction force detection system 

thereof according to the embodiments will be explained with reference to the 

accompanied drawings. 

FIG. 1 is an overall schematic view showing a floor reaction force 
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detector of a legged mobile robot, more specifically a biped robot of humanoid type 
according to the first embodiment of the invention. 

As illustrated in the figure, a biped robot of humanoid type (legged 
mobile robot; hereinafter simply referred to "robot") 1 has a pair of right and left 
legs (leg links) 2 each composed of six joints. The six joints include, arranged 
successively downward, a pair of hip joints lOR, lOL (the right-hand joint is 
indicated by R and the left-hand joint by L; hereinafter the same) for rotating legs 
with respect to crotch (hips; about a Z-axis), a pair of hip joints 12R, 12L in the 
rolling axis (about an X-axis), a pair of hip joints 14R, 14L in the pitching axis 
(about a Y-axis), a pair of knee joints 16R, 16L in the pitching axis, a pair of ankle 
joints 18R, 18L in the pitching axis, and a pair of joints 20R, 20L in the rolling axis. 

The robot is provided with feet 22R, 22L underneath of the joints 
1 8R(L) and 20R(L), and a body (trunk) 24 at its top which accommodates a control 
unit 26 and a battery (not shown). The control unit 26 comprises a microcomputer 
including CPU, ROM, RAM, etc., and is equipped with a warning light (not shown) 
informing abnormality or degradation occurred at sensor system or the like in the 
robot 1 emd a displaying device (not shown) displaying the fact of abnormality or 
degradation. A part of the RAM in the control unit 26 is equipped with a backup part 
comprising a nonvolatile memory which keeps a partial memory value even after 
stop of power supply fi-om the battery. 

In the above, the joints 10R(L), 12R(L), 14R(L) make up the hip joints 
(or waist joints; the aforesaid first joint), and the joints 18R(L), 20R(L) make up the 
foot joints (ankle joints; the aforesaid second joint). The hip joints and knee joints 
(16R(L)) are connected to each other by thigh links 28R, 28L, and the knee joints 
and ankle joints are connected to each other by cms or shank links 3 OR, SOL. The 
ankle joints and feet 22 R(L) are connected to each other by end-side links 32R, 
32L. 

As shown in the figure, a known six-axis force sensor (floor reaction 
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force detector) 34 is disposed at a position between each ankle joint 18R(L), 20R(L) 
and a floor contact end of each foot 22R(L), and measures three directional 
components Fx, Fy, Fz of force and three directional components Mx, My, Mz of 
moment of the force and detects the presence or absence of foot landing (floor 
contact) and the floor reaction force (floor contact load) acting from a floor surface 
(not shown). Moreover, the body 24 has an inclination sensor 36 which detects the 
inclination and its angular velocity with respect to the Z-axis (the vertical direction 
(the direction of gravity)). Electric motors of the respective joints are coupled with 
respective rotary encoders (not shown) that detect the rotation amounts of the 
electric motors. 

Outputs generated by these sensors including the six-axis force sensor 34 
are inputted to the control imit 26. The control unit 26 is activated by the onboard 
battery and calculates a joint displacement operation amount based on data stored in 
the ROM and the inputted detected values and moves the aforesaid drive joints. 
With the above structure, each of the legs 2 is given six degrees of freedom. When 
the 6X2 = 12 joints are driven to suitable angles during walking, a desired motion is 
imparted to the entire leg structure to enable the robot to walk arbitrarily in an 
environment of three-dimensional (absolute) space. 

The control unit 26, in accordance with algorithm stored in the ROM, 
determines a compensating floor reaction force (specifically, moment) in response to 
the inclination detected by the inclination sensor 36, as proposed in Japanese 
Laid-Open Patent Application No. Hei 10(1998)-277969. With this, a composite 
compliance control is carried out such that the detected total floor reaction force 
becomes equal to a resultant of the compensating floor reaction force and a desired 
total floor reaction force. At the same time, as proposed in Japanese Laid-Open 
Patent Application No. 2001-322076, the control unit 26 estimates the shape of a 
floor surface (which the robot contacts) based on a control deviation of the 
compensating total floor reaction force. Here, the "total floor reaction force" means 
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a total value of floor reaction forces which acts on the feet 22R(L). 

A spring mechanism 38 (explained later) is installed at a position 
between the six-axis force sensor 34 and the floor contact end of each foot 22R(L), 
whilst a sole member 40 is attached to the sole of each foot 22R(L), The spring 
5 mechanism 38 constitutes a compliance mechanism 42 together with the sole 

member 40. When the floor reaction force acts on each foot 22R(L), the spring 
mechanism 38 and the sole member 40 of the compliance mechanism 42 deform or 
bend to displace the foot 22R(L), thereby absorbing or mitigating impact at foot 
landing. 

10 The structure of the foot 22R(L), more specifically the structure of the 

six-axis force sensor 34 and other components thereabout will be explained in detail 
with reference to FIG. 2. 

FIG. 2 is an enlarged cross-sectional side view showing the structure of 
the left foot 22L (of the feet 22R, 22L) and FIG. 3 is a bottom view showing the left 

15 foot viewed from its sole. Since the feet 22R, 22L are symmetrical with each other, 

the description to the right foot 22R is omitted and the addition of R and L is 
omitted in the following explanation unless it is needed. 

As shown in FIG. 2, the six-axis force sensor 34 is fastened at a position 
between the ankle joint 18, 20 and the floor contact end of the foot 22, more 

20 precisely at a position between the ankle joint 18, 20 and the floor contact end that 

comprises the spring mechanism 38, a sole frame (second rigid member) 50, a sole 
plate 52 and the sole member 40. The spring mechanism 38 comprises an 
inverted-Q-like frame (first rigid member) 381, cylindrical rubber members (elastic 
members) 382 and bolts 383. The six-axis force sensor 34 is fastened, at its upper 

25 portion, to the end-side link 32 at a location near the ankle joint 18, 20 by a plurality 

of upper portion fastening bolts 56, while being guided to that location by a gauge 
pin 54. The end-side link 32 is made of metal (or alloy) such as titanium or 
magnesium alloy having high rigidity. 
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The six-axis force sensor 34 is connected, at its lower portion, to the sole 
frame 50 through the spring mechanism 38. A rib is integrally raised at the upper 
surface of the sole frame 50 toward the ankle joint 18, 20 to constitute a guide 
portion 50a that accommodates the inverted-Q-like frame 381 connected to the ankle 
5 joint 18, 20 so as to prevent the supporting leg from twisting about the vertical axis, 

as mentioned above. The sole frame 50 is made of metal having high rigidity. 

The inverted-Q-like frame 381 constituting the spring mechanism 38 is 
also made of alimiinum (or its alloy). The frame 381 has a recess at its middle and 
the six-axis force sensor 34 is fastened to the inverted-Q-like frame 381 by the eight 
10 bolts 58 with its lower portion being inserted in the recess. 

A ring-like member 60 (made of lubricative material) is interposed 
between the inverted-n-like frame 381 and the sole frame 50. The ring-like member 
60 acts like a piston ring when the inverted-Q-like frame 381 moves up and down 
inside a guide part 50a of the sole frame 50. 
15 Thus, the cylindrical rubber members 382 are disposed between the 

ankle joint (second joint) 18, 20 and the floor contact end of the foot 22, more 
precisely, in the space formed between the inverted-Q-like frame (first rigid 
member) 381 connected to the ankle joint 18, 20 and the sole frame (second rigid 
member) 50 connected to the floor contact end of the foot 22. A plural number of 
20 the cylindrical rubber members 382 are locally disposed or located apart from each 

other when viewed from top. 

As shown in FIG. 3, the cylindrical rubber members 382 (382a, 382b, 
382c, 382d) in four are arranged to be apart the same distance with each other near 
the edge of the foot 22. Although FIG. 3 is the bottom view, since it is symmetrical, 
25 the allocation is almost same even when viewed from top. The cylindrical rubber 

members 382 are made of synthetic rubber and have excellent elasticity. 

The inverted-Q-like frame 381 and the sole frame 50, defining the space 
where the cylindrical rubber members 382 is housed, are fastened by the bolts 383 
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(and nuts 383a) used for the spring mechanism, while sandwiching the cylindrical 
rubber members 382 therebetween. As shown in FIG. 2, an airtight space is formed 
in each of the cylindrical rubber members 382, in which displacement sensors 70 are 
accommodated (housed). 

FIG. 4 is an enlarged explanatory view showing a portion 
accommodating the displacement sensors illustrated in FIG. 2. As shown in the 
figure, each of the displacement sensors 70 comprises an electrostatic type 
pressure-sensitivity sensor 701 having a plate-like shape, a plate member 702 
disposed facing thereto, and a coil spring 703 disposed between the 
pressure-sensitivity sensor 701 and plate member 702 to bias or urge the 
pressure-sensitivity sensor 701. A sensing element and a converter (neither shown) 
are integrally housed in the pressure-sensitivity sensor 701. Outputs of the converter 
is taken from a harness 704 and sent to the control unit 26. 

As well-shown in FIG. 4, when defining top-to-bottom height (natural 
height) of the cylindrical rubber members 382 as "ht", that of the displacement 
sensors is made smaller or shorter than "ht" and set as "hs" such that the 
displacement sensors 70 are accommodated in the space defined by "ht" indicating 
the top-to-bottom height of the cylindrical rubber members 382. 

In the displacement sensors 70, when the cylindrical rubber members 
382 contract in response to load in a compressive direction due to landing of the foot 
22 or the like, the spring 703 also contracts accordingly. The pressure-sensitivity 
sensor 701 detects the stress exerted on the spring 703 and senses the spring length 
(displacement of cylindrical rubber members 382). In other words, it is configured 
such that the pressure-sensitivity sensor 701 senses the stress due to expansion and 
contraction of the spring 703 as a pressxire value and converts it to the displacement 
of the spring 703. 

Then, as described below, the stress in the cylindrical rubber members 
382 generated in response to the displacement of the spring 703, i.e., the floor 
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reaction force acting on the foot 22 from a floor surface which the robot 1 contacts, 
is calculated based on the outputs of the displacement sensors 70, by using a model 
describing the stress based on the viscoelastic characteristic of the cylindrical rubber 
members 382. 

In this manner, the displacement sensors 70 comprise the 
pressure-sensitivity sensor 701, spring 703, etc., and is configured to generate the 
outputs indicating the displacement (moving distance) of the floor contact end of the 
foot 22 relative to the ankle joint 18, 20, i.e., the displacement (moving distance) 
between the inverted-Q-like frame 381 and the sole frame 50 and based on the 
outputs, to detect the floor reaction force (load) acting on the foot 22. 

Here, rigidity of the spring 703 should be set sufficiently lower than that 
of the cylindrical rubber members 382, so as to prevent the effect to attenuate 
oscillation by the viscosity of the cylindrical rubber members 382 from being 
degraded. 

Explaining the detection axis of the six-axis force sensor 34, etc., with 
reference to FIG. 3, the sole (foot sole surface) of the foot 22 has an almost 
rectangular shape and the six-axis force sensor 34 is installed at a position slightly 
rearward from the center in the front-and-back direction (in the direction of the 
X-axis). In the figure, "Xc" indicates the detection axis of the six-axis force sensor 
34 in the direction of the X-axis and "Yc" indicates that in the direction of the 
Y-axis. These detection axes Xc and Yc orthogonally intersect the leg center line 
"ftc" in the direction of a Z-axis (as is best shown in FIG. 2). Thus, the six-axis force 
sensor 34 is installed in such a manner that the detection axis Zc is made equal to the 
leg center line ftc. 

It should be noted in the above that the front-and-back direction (the 
X-axis direction) is a direction in which the robot 1 advances, as will be understood 
from FIG. 1. The right-and-left (sidewise) direction is the Y-axis direction that 
orthogonally intersects the X-axis direction (advancing direction) and the Z-axis 
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direction (direction of gravity or vertical-axis). 

The six-axis force sensor 34 is installed in such a manner that the 
detection axis Zc thereof is positioned at the center of each pair of the cylindrical 
rubber members 382 (382a and 382c, or 382b and 382d; indicated by the bolts 383 
also hidden behind the sole). 

Specifically, the sensor 34 is installed in such a manner that the 
detection axis Zc thereof is positioned at the center of the two members 382a and 
382c located in the advancing direction (X-axis direction), i.e., the detection axis Xc, 
and at the center of the two members 382b and 382d in the right-and-left direction 
(Y-axis direction), i.e., the detection axis Yc. Thus, the sensor 34 is installed in such 
a manner that its detection axis Zc is positioned at the center of gravity or center of 
mass of a rectangle (more precisely a square with four equal sides) formed by the 
four cylindrical rubber members 382 (382a, 382b, 382c, 382d). 

In FIG. 2, reference numeral 62 indicates an amplifier of the 
displacement sensor 70 and reference numeral 64 a toe of the foot 22. 

The legged mobile robot according to this embodiment is configured 
such that, as mentioned above, the four displacement sensors 70 made of the sensing 
element and converter are locally installed (accommodated) in the space defined by 
"ht" which is designated as the top-to-bottom height of the cylindrical rubber 
members 382, in top view. With that, since the displacement sensors 70 are 
configured such that the displacement of the floor contact end of the foot 22 can be 
detected, it is possible to make the displacement sensors 70, including the converter, 
compact enough to be installed in the limited space of the cylindrical rubber 
members 382 at the foot 22 of the robot 1. 

Further, the displacement sensors 70 are housed inside the airtight 
spaces of the cylindrical rubber members 382, whilst each of the four cylindrical 
rubber members 382 is installed locally between the ankle joint 18, 20 and floor 
contact end of the foot 22 in top view, more precisely near the edge of the foot 22, 
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thereby optimizing elasticity of the foot 22. The foot 22 of the robot 1 shown in the 
figure should preferably have appropriate elasticity for both of the bending 
(rotational) direction and up-and-down direction. However, if the cylindrical rubber 
members 382 are unevenly gathered about the center of the foot and if their 
elasticity coefficient is set so that the bending elasticity is appropriate, the elasticity 
in the up-and-down direction might occasionally become hard excessively, for 
instance. In that case, the requirements contradict and it becomes difficult to satisfy 
both of the requirements. In this embodiment, however, the contradicted 
requirements can be achieved by the above-mentioned configuration. 

Further, it is configured such that the displacement sensors 70 are 
housed in the airtight space (chamber), i.e., is sealed in the space. It makes possible 
to prevent the displacement sensors 70 from adhering or intruding of foreign 
substances such as liquid or dust, thereby enabling to enhance the dvirability of the 
displacement sensors 70. Moreover, as receiving less influence from the ambient 
temperature, it can decrease the necessity of correction, e.g., temperature 
compensation. 

Furthermore, it is configured such that the displacement sensors 70 
comprise the spring 703 and the pressure-sensitivity sensor 701, thereby achieving 
to make the structure of the sensors more compact compared to the case of detecting 
from the normal displacement (stroke). 

Specifically, a normal stroke sensor needs thickness (height) adding a 
movable space equal to or greater than a usable stroke efst which can be actually 
measured, to the length of a shaft hshaft, as drawn in dashed line in FIG. 4. 
Accordingly, even if the length of the shaft hshaft is set to equal to the usable stroke 
efst (i.e., whole length of the shaft is effective as the usable stroke), a value of 2 X 
efst is still needed for the thickness of the stroke sensor at the minimum. 

Therefore, if the cylindrical rubber members 382 contracts at or below 
the half of the natural length ht (i.e., efst needs the length equal to or more than ht/2). 
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the stroke sensor cannot be installed inside the space defined by the top-to-bottom 
height of the cylindrical rubber members 382. Since the whole length of the shaft 
can be hardly used as the usable stroke actually, the thickness of the stroke sensor 
tends to be equal to or more than 2 X efst and the trouble will become more apparent. 
5 Contrary, in the displacement sensors 70 according to this embodiment, the 

elasticity of the spring 703 and sensitivity of the pressure-sensitivity sensor 701 are 
appropriately set, thereby achieving "hs" less than "ht" which is the natural length of 
the cylindrical rubber members 382. 

Further, it is configured such that rigidity of the spring 703 is lower than 
10 that of the cylindrical rubber members 382. Accordingly it can avoid degradation of 

the effect to attenuate oscillation of the cylindrical rubber members 382. 

FIG. 5 is a flow chart showing the operation of detecting abnormality 
(i.e., self-diagnosing) of a displacement sensor illustrated in FIG. 2, in the operation 
of the legged mobile robot and the floor reaction force detection system thereof, 
1 5 according to a second embodiment of the invention; 

In the second embodiment, it is configured to self-diagnose abnormality 
occurred in the displacement sensors 70 installed at the foot 22 of the legged mobile 
robot explained in the first embodiment. Since the four displacement sensors 70 are 
installed, their redundancy is used to detect abnormality (self-diagnose) of the 
20 displacement sensors 70 in the second embodiment. 

The second embodiment will be explained. 

In FIG. 3, when defining outputs (which indicate the displacement or a 
contraction amount of the cylindrical rubber member 382) of the displacement 
sensors 70a, 70b, 70c, 70d installed in each of the cylindrical rubber member 382a, 
25 382b, 382c, 382d, as LI, L2, L3 and L4, if the four displacement sensors 70 are 

normal, Eq. 1 is always satisfied from a geometrical relationship. Here, the sensor 
outputs are assumed to have no offsets. 

LI +L3-L2-L4 = 0 ...Eq. 1 
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FIG. 5 is the flow chart showing the operation of detecting abnormality 
(self-diagnosing) occurred in the displacement sensors 70 based on Eq. 1 . 

The program is activated at the control unit 26 in every control cycle, 
e.g., in every 10 msec for each of the right and left legs (leg 2). 

The program begins at SIO in which, detected values Ln of the four 
displacement sensors 70 are read, and proceeds to SI 2 in which it is determined 
whether the absolute value in the left side of Eq. 1 is equal to or less than a 
permissible value (predetermined value) e , The value is positive and close to 0, or a 
value close thereto. If the left side of Eq. 1 is not to be the absolute value, it is a 
value close to 0. In other words, it is determined whether the detected values Ln 
approximately satisfy Eq. 1 . When it is to be determined more strictly whether the 
detected values Ln satisfy Eq. 1, it suffices if the permissible value e is set to 0 and 
the inequality sign is changed to the equality sign. If there are offsets at the located 
position of the displacement sensors 70, the left side of Eq. 1 should be LI + L3 - 
L2 - L4 + C (C: predetermined value) or it should be determined at S12 whether the 
difference between LI + L3 and L2 + L4 is equal or almost equal to a predetermined 
difference. 

When the result at S12 is affirmative, the program proceeds to S14 in 
which it is determined that the four displacement sensors 70 are all normal and the 
bit of a flag F is reset to 0. On the other hand, when the result at SI 2 is negative, the 
program proceeds to S16 in which it is determined that abnormality such as wire 
disconnection has occurred in all or at least one of the four displacement sensors 70 
and the bit of the flag F is set to 1 . At the same time, a warning light is lit and the 
display device is made on. The waming lights can be increased in line with to 
detection objects such as one that should be lit when the displacement sensors 70 is 
determined to be abnormal, one that should be lit when at least one of the 
displacement sensors 70, six-axis force sensor 34 and cylindrical rubber members 
382 is determined to be degraded (explained below), and the rest that should be lit 
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when the six-axis force sensor 34 is determined to be abnormal (explained below). 

Thus, this embodiment is configured to have comprise the four (a 
plurality of) displacement sensors 70 installed in the space formed between the 
inverted-Q-like frame (first rigid member) 381 connected to the ankle joint 18, 20 
5 and the sole frame (second rigid member) 50 connected to the floor contact end of 

the foot 22, located apart from each other near the edge of the foot 22 in top view, 
that generates the outputs indicating the displacement h (Ln) of the floor contact end 
of foot 22 relative to the ankle joint 18, 20, and the self-diagnoser that determines 
whether the outputs Ln from the displacement sensors 70 satisfy the predetermined 

10 geometric relationship and self-diagnoses whether abnormality has occurred in at 

least one of the four displacement sensors 70 based on a determined result. 

In other words, it is configured to self-diagnose whether the 
displacement sensors 70 are abnormal based on the determined result whether the 
sensor outputs Ln approximately (or accurately) satisfy Eq. 1, by utilizing the 

15 redundancy of location or allocation of the four displacement sensors 70, i.e., the 

geometric relationship of sensor location. Accordingly, even though the 
displacement sensors 70 are disposed at the foot 22 of the robot 1 to suffer from the 
impact at foot landing, the detection accuracy can be improved. 

Further, it is configured such that the geometric relationship is such that 

20 the difference between outputs of displacement sensors located at opposite positions 

is less than the permissible value a (specifically, 0 or a value close thereto, more 
specifically, a value close to 0). Therefore, it can easily and promptly self-diagnose 
whether the displacement sensors 70 are abnormal, thereby enhancing the detection 
accuracy. The rest of the structure and effect is the same as that of the first 

25 embodiment. 

FIG. 6 is an explanatory view showing a model approximating a 
characteristic of a cylindrical rubber member (elastic member) in the operation of 
the legged mobile robot and the floor reaction force detection system thereof 
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according to a third embodiment of the invention. 

In order to control the robot 1 to walk more stably, it is preferable to 
detect not only the displacement of the foot 22 but also the floor reaction force 
acting on the foot 22. When the six-axis force sensor (floor reaction force detector) 
5 34 is installed at each foot 22 to detect the floor reaction force acting on the foot 22, 

if the displacement sensors 70 is additionally used such that the floor reaction force 
is calculated or estimated based on the outputs of the displacement sensors 70, a 
dual sensor system can be constituted by combining such different types of detectors, 
thereby enabling to enhsmce the detection accuracy. 
10 Further, the six-axis force sensor or the like is liable to suffer from the 

impact at foot landing as mentioned above. In order to improve the detection 
accuracy, it is preferable to self-diagnose degradation or abnormality of the six-axis 
force sensor 34, etc., based on the outputs of the displacement sensors 70. 

In the third embodiment, it is configured, therefore, to self-diagnose 
15 degradation or abnormality of the six-axis force sensor 34, etc., based on the outputs 

of the displacement sensors 70, while calculating (estimating) the floor reaction 
force acting on the foot 22 from the floor surface based on the outputs of the 
displacement sensors 70. 

This will be explained. The operation thereof is also carried out in the 
20 control unit 26. 

The characteristic of the cylindrical rubber members 382 installed at the 
right and left feet 22 (the aforesaid stress characteristic) is approximated by a 
viscoelastic model comprising a spring (first spring) having a spring constant Kb, a 
(virtual) dumper having a dumping constant D arranged in series therewith, and 
25 another spring (second spring) having spring constant Ka arranged in parallel 

therewith. The characteristic is expressed as follows: 
Fn= — KaXLn~KbX(Ln— Xn) + C 

D X d (Xn) / dt = Kb X (Ln-Xn) . . .Eq. 2 
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Here, except for Ln mentioned above, Fn: stress generated in the 
cylindrical rubber members 382, Xn: contraction amount (displacing amoimt) of the 
(virtual) dumper in the viscoelastic model, d (Xn) / dt: time derivative value of Xn, 
Ka and Kb: spring constants, D: dumping constant and C: constant indicating offsets, 
"n" indicates one of the four cylindrical rubber members 382a to 382d, specifically, 
n = 1 : 382a, n = 2 : 382b, n = 3 : 382c, n = 4 : 382d. 

The characteristic can be approximated taking nonlinearity of the 
cylindrical rubber members 382 into account, as follows: 
Fn = -fl (Ln)-f2 (Ln-Xn) + C 

DXd(Xn)/dt = f2X(Ln— Xn) ...Eq. 2 -1 

Here, fl and f2 are functions increasing monotonically relative to the 

inputs. 

FIG. 7 is a schematic view of the foot 22. In the third embodiment, the 
floor reaction force acting on the foot 22 is expressed by the center point in the X 
and Y directions of the location of the four displacement sensors 70 as a point of 
action, for the ease of understanding. Precisely, a middle point P of the height 
(natural length) of the cylindrical rubber members 382 indicates the point of action. 
In the figure, the end-side link 32 is omitted. 

A translational element of the floor reaction force detected by the 
six-axis force sensor 34 is indicated by a vector Ffs, and force components in the X, 
Y and Z directions respectively Ffsx, Ffsy and Ffsz. A moment components about 
these axes are indicated by a vector Mfs and X, Y and Z-axis directional 
components respectively Mfsx, Mfsy and Mfsz. 

Similarly, a vector Ffbz indicates a Z-axis directional component of the 
translational element of the floor reaction force estimated from the detected value of 
the four displacement sensors 70 and Mfbx and Mfby respectively X- and j Y-axis 
directional elements of the moment components. The above yields Eq. 3 as fojlows: 
Ffbz = Fl + F2 + F3 + F4 ...Eq. 3a 
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Mfbx= {(F2-F4)Xdl } /2 ...Eq. 3b 

Mfby={(-Fl +F3)Xd2}/2 ...Eq. 3c 

Since the viscoelastic characteristic of the cylindrical rubber members 
382 is assumed to be known, Eqs. 2 (or 2 -1) and 3a to 3c are established. Thus, the 
three (axial force) components of the floor reaction force can be accurately 
calculated (estimated) based on the outputs of the displacement sensors 70 (the other 
components cannot be detected from the principle). In the above, dl: distance 
between the displacement sensors 70b and 70d and d2: distance between the 
displacement sensors 70a and 70c. 

Assuming the relative height relative to the sole frame 50 of the 
inverted-Q-like frame 381 supporting the cylindrical rubber members 382 
(displacement of the contact end of the foot 22 relative to the ankle joint 18, 20) as h, 
the relative inclination about the X-axis as 9x (not shown), and the relative 
inclination about the Y-axis as 0y. LI, L2, L3, L4 and the relationship among them 
can be expressed as follows: 

h = (LI + L2+ L3 + L4) / 4 ...Eq. 4a 

ex = (L2-L4)/dl ...Eq. 4b 

ey = (L3-Ll)/d2 ...Eq. 4c 

Instead of Eq. 4a, it is possible to use one of the following equations 4a 
-1 or 4a -2. However, the above equation is better when taking measurement errors 
into account. 

h = (Ll +L3)/2 ...Eq.4a-1 
h-(L2 + L4)/2 ...Eq.4a-2 

The floor reaction force is estimated using an observer 90 illustrated in 
FIG. 8 (a). The observer 90 has a model (spring mechanism model) designed based 
on Eqs. 1, 2 (2 -1), 3a, 3b, 3c, 4a, 4b, 4c, that inputs h, Gx, 0y and outputs Ffbz, 
Mfbx, Mfby (whose quantity of stated is defined as Xn). The observer 90 estimates 
Ffbz, Mfbx, Mfby from LI, L2, L3, L4 based on the relationships mentioned above 
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in a maimer mentioned below. 

First, the quantity of state Xn of the illustrated model is initialized. This 
is done by making it equal to a theoretical value of the displacement sensor*s 
detected value when the floor reaction force is not acting on the foot 22, or making it 
equal to the theoretical value of the sensor's detected value when the robot 1 is in an 
upright position such that the floor reaction force acts on the feet 22. Specifically, 
the theoretical value should be determined based on an assumed value of floor 
reaction force acting on the foot 22 of the robot 1 when the initialization is carried 
out. Since the quantity of state Xn has convergence, even if the initialized value 
V2iriants, it does not cause a problem. 

Next, the displacement sensor detected values LI, L2, L3, L4 are 
substituted to Eqs 4a, 4b and 4c to calculate h, 9x, 0y. Then, Ffbz, Mfbx, MflDy 
are calculated for each leg 2 by using the model illustrated in the figure. 

Then errors Fferrz, Mferrx, Mferry between the calculated Ffl^z, Mfbx, 
Mfby and Ffsz, Mfsx, Mfsy (corresponding thereto) of the floor reaction force 
components detected by the six-axis force sensor 34 are determined as follows: 

Fferrz = Ffsz - Ffbz 

Mferrx = Mfsx - Mfbx 

Mferry = Mfsy — Mfby 

...Eq. 5 

It becomes possible to discriminate or self-diagnose whether the six-axis 
force sensor 34 is abnormal by determining whether the errors calculated as 
mentioned are within permissible ranges. 

This will be explained with reference to a flow chart of FIG. 9. The 
program in the figure is also activated at the control unit 26 in every control cycle, 
e.g., in every 10 msec for each of the right and left legs (leg 2). 

The program begins at SI 00 in which it is determined whether the 
displacement sensors 70 are detected or determined to be normal. This is done by 
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referring to the bit of the flag explained with reference to the flow chart in FIG. 5 in 
the second embodiment. When the result at SI 00 is negative, the program is 
immediately terminated, since the following abnormality detection cannot be 
performed. When the robot 1 is walking in this case, if possible, it is preferable to 
control the robot to stop walking within a short period of time without losing the 
djoiamical equilibrium condition. 

When the result at SI 00 is affirmative, the program proceeds to 8102 in 
which it is determined whether the error Fferrz is equal to or greater than a first Fz 
permissible value Frefzl and is less than a second Fz permissible value Frefz2. 
When the result is affirmative in 8102, the program proceeds to 8104 in which it is 
determined whether the error Mferrx is equal to or greater than a first Mx 
permissible value Mrefxl and is less than a second Mx permissible value Mrefx2. 
When the result at SI 04 is affirmative, the program proceeds to SI 06 in which it is 
determined whether the error Mferry is equal to or greater than a first My 
permissible value Mrefyl and is less than a second My permissible value Mrefy2. 

When the resuh at SI 06 (or at 8102 and 8104) is negative, the program 
proceeds to 8108 in which a count value C is incremented by one, and then to 81 10 
in which it is determined whether the count value C exceeds a predetermined value 
Cref (appropriately set). The count value C is stored in the backup memory of the 
control unit 26 and kept even after the power supply thereto is terminated. 

When the result at 81 10 is affirmative, the program proceeds to 81 12 in 
which it is determined that at least one of the displacement sensors 70, six-axis force 
sensor 34 and cylindrical rubber members 382 (more precisely, at least one of the 
cylindrical rubber members 382) is degraded and, at the same time, the warning 
light is lit and the display device is made on. When the result at 8110 is negative, 
81 12 is skipped. 

When the result at 8106 is affirmative, the program proceeds to 81 14 in 
which it is determined whether the error Fferrz is equal to or greater than a third Fz 
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permissible value Frefz3 and is less than a fourth Fz permissible value Frefz4. When 
the result is affirmative, the program then to SI 16 in which it is determined whether 
the error Mferrx is equal to or greater than a third Mx permissible value Mrefx3 and 
is less than a fourth Mx permissible value Mrefx4. When the result at S116 is 
affirmative, the program proceeds to SI 18 in which it is determined whether the 
error Mferry is equal to or greater than a third My permissible value Mrefy3 and is 
less than a fourth My permissible value Mrefy4. 

When the result at SI 18 is affirmative, the program proceeds to SI 20 in 
which it is determined that the six-axis force sensor 34 is normal. Contrary, when 
the result at any of SI 14, SI 16 and SI 18 is negative, the program proceeds to SI 22 
in which it is determined that abnormality such as wire disconnection has occurred 
in the six-axis force sensor 34, and, at the same time, the waming light is lit and 
display device is made on. 

The fact that the errors are not within the permissible ranges (set to be 
narrower than the degradation-discrimination permissible ranges) indicates that the 
errors become values that cannot occur at degradation. Although whichever of the 
displacement sensors 70, six-axis force sensor 34 and cylindrical rubber members 
382 may be a cause, the displacement sensors 70 can be excluded since it has 
experienced the determination at SI 00. In addition, since the structure of the six-axis 
force sensor 34 is more complicated than that of the displacement sensors 70, once 
abnormality other than degradation has occurred, the six-axis force sensor 34 is 
likely to outputs a value far beyond the permissible ranges immediately. For that 
reason, when the result at any of SI 14, SI 16 and SI 18 is negative, it is determined 
or self-diagnosed that abnormality has occurred in the six-axis force sensor 34. 

The first and second permissible values are set to properly selected 
values that enable to determine whether the displacement sensors 70, etc., degrade. 
Here, "degradation" means that it is not normal, but is not yet abnormal (not failed). 
Accordingly, yet the result at SI 00 is affirmative, the displacement sensor 70 is 
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included as the subject to be determined at SI 12, since the possibility mentioned 
above still remains. 

The third and fourth permissible values used from SI 14 to 118 are 
determined such that the permissible ranges defined by them are set to be narrov^er 
than that defined by the first and second permissible values used from SI 02 to 106, 
and are determined to properly selected values that enables to determine whether 
abnormality has occurred in the six-axis force sensor 34. 

If it is determined at SI 22 that the six-axis force sensor 34 is abnormal, 
instead of the output of the six-axis force sensor 34, the floor reaction force 
estimated from the outputs of the displacement sensors 70 should be used in the 
composite compliance control or floor shape estimation. At that time, when the 
robot walking is in progress, the robot 1 should be controlled to stop walking within 
a short period of time, without losing dynamic equilibrium condition. 

In the case of using the estimated value obtained from the outputs of the 
displacement sensors, instead of that of the six-axis force sensor output, it is 
preferable to change a gain and a characteristic of compensating circuit in the 
composite compliance control or floor shape estimation. This is because the floor 
reaction force estimated from the outputs of the displacement sensors 70 is inferior, 
in terms of response, to the detected value of the six-axis force sensor 34. 

In the processing from SI 02 to 106 and SI 14 to 118, it is alternatively 
possible to filter the errors through a low-pass filter (not shown), to calculate 
absolute values of the filtered values and the calculated absolute values are then 
compared with appropriate values determined through experimentation beforehand. 
Further, by counting the number of times S114 to SI 18 found negative and by 
comparing the count with an appropriate value, it is altematively possible to 
determine whether the six-axis force sensor 34 is abnormd. Although the errors 
between the calculated value and detected value are used in the processing at SI 02 
to 106 and S114 to 118, ratios of the calculated value to the detected value can 



28 



instead be used. 

In the third embodiment, it is thus configured to have the displacement 
sensors 70 disposed in the cylindrical rubber members 382 located at a position 
between the ankle joint 18, 20 and floor contact end of foot 22 and generating the 
5 outputs indicating the displacement of the floor contact end of the foot 22 relative to 

the ankle joint 18, 20, and the observer 90 that calculates the floor reaction forces 
Ffbz (force component acting in the vertical direction), and Mfbx, Mfby (moment 
components acting about axis that orthogonally intersects the vertical axis) acting on 
the foot 22 based on the outputs Ln of the displacement sensors 70 with the use of 

10 the model describing the relationship between the displacement and the stress Fn 

generated in the cylindrical rubber members 382 by the aforesaid displacement. 
With this, the floor reaction force can be accurately calculated, thereby enabling to 
control the robot 1 to walk stably. 

Further, the model is configured to have the spring having spring 

15 constant Kb, dumper having dumping constant D arranged in series therewith and 

spring having spring constant Ka arranged in parallel therewith. In other words, it is 
configured to use the model designed by taking into account the dumping constant 
(characteristic) D of the cylindrical rubber members 382, thereby enabling to obtain 
the estimated value of the floor reaction force having excellent frequency 

20 characteristic, i.e., to calculate the floor reaction force with high response. 

Furthermore, it is configured to estimate the floor reaction force by 
estimating dumper' s displacement Xn by the observer 90, it becomes possible to 
further enhance the detection accuracy in calculating the floor reaction force. 

Further, it is configured such that the six-axis force sensor (second floor 

25 reaction force detector) 34 (that generates the output indicative of the floor reaction 

force acting on the foot 22 from a floor surface which the robot 1 contacts), is 
disposed at a position between the ankle joint 18, 20 and the floor contact end of the 
foot 22, it becomes possible to provide a dual sensory system by combining these 
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different kinds of sensors, thereby enabling to enhance the detection accuracy. 

Further, it is configured to self-diagnose whether at least one of the 
displacement sensors 70, six-axis force sensor 34 and cylindrical rubber members 
382 degrade or become abnormal on the basis of the floor reaction force calculated 
from the outputs of the displacement sensors 70 and that detected from the output of 
the six-axis force sensor 34, more specifically, based on their errors Fferrz, Mferrx, 
Mferry. The degradation or abnormality, therefore, can be easily and promptly 
self-diagnosed, thereby enabling to further enhance the detection accuracy. 

Further, since it is configured such that the warning light is lit and the 
display device is made on when the degradation or abnormality is detected, it makes 
possible to inform the fact to an operator. From this, when the six-axis force sensor 
34 is self-diagnosed to be normal, the detection of the floor reaction force from the 
outputs of the six-axis force sensor 34 is continued. On the other hand, when the 
six-axis force sensor 34 is self-diagnosed to be abnormal, it is possible to take an 
appropriate action such as stopping the robot walking within a short period of time, 
without losing the dynamical equilibrium condition. 

In the spring mechanism model in the third embodiment, instead of 
defining Xn as the quantity of state, values determined firom the following Eqs. 6a, 
6b and 6c (indicated by adding "st") can be used. In other words, hst, 9 stx, 8 sty 
can be used as the quemtity of state. 

hst = (Xl +X2 + X3+X4)/4 ...Eq.6a 
^ stx = (X2 - X4) / dl . . .Eq. 6b 

e sty = (X3 - XI) / d2 . . .Eq. 6c 

XI +X3-X2-X4 = 0 ...Eq. 7 

As shown in FIG. 8(b), based on Eqs. 1, 2(Eq. 2 -1), 3a, 3b, 3c, 4a, 4b,4c, 
6a, 6b and 6c, the observer 90 may use a model (spring mechanism model) having 
hst, 9 stx, 9 sty as the quantity of state, while inputting h, 9x, 9y and outputting 
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Ffbz, Mfbx, Mfby. 0 

In this case, although the number of quantity of state decreases by one, it 
does not cause a problem. Since, if the linearity is established as shown in Eq. 2, 
ratios of d(Xl) / dt : d(X2) / dt : d(X3) / dt : d(X4) / dt converge with passage of 
time (more specifically, after a period of time (sufficiently longer than a time 
constant of the spring mechanism expressed by Eq 2) has passed), to those of d(Ll) / 
dt : d (L2) / dt : d(L3) / dt : d(L4) / dt, regardless of its initial condition, and the 
relationship expressed in Eq. 7 can be almost established. Therefore, one 
independent variable can be decreased. It should be noted that, if Eq. 2 -1 is used, 
since the system becomes nonlinear and it does not have the above-mentioned 
property, it becomes impossible to design the spring mechanism model shown in 
FIG. 8(b). 

It should be noted that, in the third embodiment, a temperature sensor 
may be installed to detect temperature such that the spring constants Ka, Kb and 
dumping constant D are compensated by the detected temperature. 

FIG. 10 is a view, similar to FIG. 3, but showing a legged mobile robot 
and a floor reaction force detection system according to a fourth embodiment of the 
invention, specifically the configuration of a left foot 22L of feet 22R, L of the 
legged mobile robot. 

In the fourth embodiment, as will be understood when comparing FIG. 
10 with FIG. 3, the location of the cylindrical rubber members 382 is rotated right 
by 45 degrees fi-om that illustrated. Since the structure of the third embodiment is 
obtained by adding only geometrical rotational transformation to that of the first 
embodiment, the rest of the structure and effect is the same as that of the first 
embodiment. 

In this fourth embodiment £is well as the aforesaid first embodiment, for 
the ease of calculation, it is configured such that the cylindrical rubber members 382 
having the displacement sensors 70 therein are arranged in such a manner that each 
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pair of opposed ones is evenly spaced apart with each other, i.e., the lines (dashed 
line) connecting them form a square shape. However, it may be arranged such that 
only paired members are positioned evenly spaced apart with each other such that a 
rectangular shape is formed, or the four members may be eirranged unevenly spaced 
5 apart to be a trapezoid, i.e., it may be arranged to have any shape. Further, the 

number of the displacement sensors is not limited to four but can be five or more. 

FIG. 1 1 is a view, similar to FIG. 3, but showing a legged mobile robot 
and a floor reaction force detection system according to a fifth embodiment of the 
invention, specifically the configuration of a left foot 22L of feet 22R, L of the 
10 legged mobile robot. 

In the fifth embodiment, as shovm in the figure, the six-axis force sensor 
34 is located in such a manner that the sensitivity center line Zc thereof is positioned 
at the center of gravity or center of mass of the triangle formed by the three 
cylindrical rubber members 382 (382a, 382b, 382c), whilst the displacement sensors 
15 70a, 70b, 70c are disposed in the cylindrical rubber members respectively. 

Since the number of the displacement sensors 70 is three, it is impossible 
to detect or self-diagnose whether the displacement sensors 70 are abnormal. In that 
sense, the illustrated configuration is a simple alteration of that of the first and 
second embodiments. Nevertheless, since a plane can be still formed by the three 
20 displacement sensors 70, it is possible to estimate or calculate the floor reaction 

force with respect to the aforesaid three axes. 

It should be noted that, although the number of the displacement sensors 
70 is three in the fifth embodiment and four in the first to fourth embodiments, it is 
not limited thereto. The number of displacement sensor 70 may be one at minimum. 
25 In that case, however, only the force component in the vertical-axis direction (the 

aforesaid Ffbz) of the floor reaction force can be estimated or calculated and the 
abnormality detection described in the second embodiment cannot be performed. 

When the number of the displacement sensors 70 is made two, among of 
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the components of the floor reaction force, in addition to the force component in the 
vertical-axis direction (the aforesaid Ffljz), the moment component about a 
horizontal axis that orthogonally intersects a line connecting the two displacement 
sensors 70 can be detected or calculated. If the number of the displacement sensors 
70 is made three, as mentioned above, the three-axes force components of the floor 
reaction force can be estimated or calculated. 

FIG. 12 is a view, similar to FIG. 2, but showing a legged mobile robot 
and a floor reaction force detection system according to a sixth embodiment of the 
invention and FIG. 13 is a schematic bottom view of a foot illustrated in FIG. 12. 

In the sixth embodiment, it is configured such that, in the configuration 
of the first embodiment illustrated in FIG. 3, the four cylindrical rubber members 
382 are disposed at a position between the ankle joint 18, 20 and floor contact end of 
the foot 22 and the four displacement sensors 70 (made of the sensing element and 
converter) are located in a space defined by the top-to-bottom height of each 
cylindrical rubber member 382. More specifically, they are not housed in the 
cylindrical rubber members 382, but is position in the vicinity thereof (more 
precisely, on a line connecting the two cylindrical rubber members 382 that oppose 
with each other), thereby enabling to detect the displacement of the floor contact end 
of the foot 22 relative to the ankle joint 18, 20. 

As shown in FIG. 12, similar to the first embodiment, each of the 
displacement sensors 70 comprise the capacitance type pressure-sensitivity sensor 
701 of a plate-like shape, the plate member 702 disposed at an opposite position 
thereof, and the spring 703 disposed between the pressure-sensitivity sensor 701 and 
plate member 702 to bias the pressure- sensitivity sensor 701. The sensing element 
and converter (neither shown) are integrally housed in the pressure-sensitivity sensor 
701. Outputs of the converter is taken from the harness 704 and sent to the control 
unit 26. The displacement sensors 70 are airtightly housed in the housing 706, i.e., 
inside the sealed space. 
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Since the sixth embodiment is configured as mentioned above, similar to 
the first embodiment, it becomes possible to make the sensor (including their 
components such as the converters) compact to be housed in the limited space of the 
elastic members at the foot of the legged mobile robot. 
5 In the sixth embodiment, the displacement sensors 70 may be arranged 

as illustrated in FIG. 14. In other words, they may be located on a line (not shown) 
connecting the two adjacent cylindrical rubber members 382. Further, the mmiber of 
the displacement sensors 70 may be different from that of the cylindrical rubber 
members 382, as shown in FIG. 15. The rest of the arrangement and effects is the 
10 same as that of the first embodiment. 

FIG. 16 is a view, similar to FIG. 2, but showing a legged mobile robot 
and a floor reaction force detection system according to a seventh embodiment of 
the invention. 

In the seventh embodiment, it is configured such that the six-axis force 
15 sensor 34 is removed and the displacement sensors 70 are housed or disposed in the 

four cylindrical rubber members 382, respectively. Accordingly, also in the seventh 
embodiment, the self-diagnosis of the displacement sensors are carried out and only 
the floor reaction force estimated from the outputs of the displacement sensors 70 is 
sent to the control unit 26. The control is performed based on the estimated value. 
20 Except for the fact that the inverted-Q-like frame 381 is fastened to the end-side link 

32 by the bolts 58, the rest of the structure and effect is the same as that of the above 
embodiment. 

FIG, 17 is an explanatory view showing the configuration of a legged 
mobile robot and a floor reaction force detection system according to an eighth 
25 embodiment of the invention. 

In the eighth embodiment, it is configured to add an adaptive observer to 
the structure of the third embodiment. The viscoelastic characteristic of the 
cylindrical rubber members 382 highly depends on temperature and hence, in the 
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viscoelastic model explained above, the spring constants Ka, Kb and dumping 
constant D are likely to change greatly with the temperature. Further, the spring 
constants Ka, Kb and dumping const£int D may change (degrade) after having used 
for a long period of time. If the compensation is attempted by disposing a 
5 temperature sensor, the configuration becomes complicated. In any rate, it can not 

cope with the change with time. 

As a result, if the parameters (Ka, Kb, D) in Eq. 2 are deemed as 
constants, an error occurs in estimation (calculation) of the floor reaction force from 
the outputs of the displacement sensors 70 due to the temperature dependency and 
1 0 chsinge with time. 

In view of the above, in the eighth embodiment, it is configured to 
identify these pareimeters using the adaptive observer such that the floor reaction 
force is estimated or calculated from the estimated value obtained, thereby enabling 
to enhance the accuracy to estimate the floor reaction force from the outputs of the 
1 5 displacement sensor 70. 

The abnormality of the displacement sensors 70 is self-diagnosed in the 
first embodiment and the degradation of the cylindrical rubber members 382 and 
displacement sensors 70, etc., as well as the abnormality of the six-axis force sensor 
34 are self-diagnosed in the third embodiment. Aside from the above, in the eighth 
20 embodiment, the parameters of the model indicating the spring constants Ka, Kb and 

dumping constant D are identified by the adaptive observer such that degradation of 
the cylindrical mbber members 382 can be accurately self-diagnosed fi-om the 
parameter-identified values obtained accordingly. 

The adaptive observer comprises an identifier mechanism which 
25 identifies unknown parameters in the observer coping with the case that parameter 

values change with environmental change around the system or the case that the 
parameter values cannot be determined accurately. The structure of the observer is 
as shown in FIG. 17. The adaptive observer illustrated in the figure is publicly 
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known. For example, it is described in "Modem Control Series; Observer" (Corona 
Publishing Co., Ltd. October, 1988). 

Explaining this with reference to the figure, the adaptive observer 100 
includes a state variable filter that inputs state variables, a parameter identifier, an 
output estimator and a state estimator. As mentioned above, since the six-axis force 
sensors 34 and displacement sensors 70 are installed in each of the right and left legs, 
the adaptive observer 100 is provided for each of the right and left legs. Specifically, 
the adaptive observer lOOR is installed for the right leg and adaptive observer lOOL 
is installed for the left leg. Although the input values are different from each other, 
since the calculations performed therein are the same, the addition of R and L is 
omitted in FIG. 17. 

The adaptive observer 100 is inputted with Ffsz, Mfsx, Mfsy that are the 
outputs of the six-axis force sensor 34 and are corresponding to those estimated 
from the outputs of displacement sensors 70 and are the same as the three axis 
components Ffbz, Mfbx, Mfby obtained from Eq. 3. The adaptive observer is also 
inputted with the relative height h relative to the sole frame 50 (displacement of the 
contact end of the foot 22 relative the ankle joint 18, 20) of the inverted-Q-like 
frame 381 that supports the cylindrical rubber members 382, the relative inclination 
Ox about the X-axis (not shown) and the relative inclination 0y about the Y-axis, 
all of which are obtained from Eq. 4. 

h, 0x and 9y are calculated from the contraction amount Ln of the 
cylindrical rubber members 382 (value detected by the displacement sensors 70), 
using Eq. 4. 

In the adaptive observer 100, the parameter identifier identifies the 
spring constants K a, Kb and the dumping constant D as the identified 
parameters on the basis of a state variable z(t). The output estimator inputs the state 
variable z(t) and the identified parameters and outputs the three axis elements F fbz, 
M fbx, M fby as estimated outputs. 
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The estimated outputs of the output estimator F fbz, M fbx, M fby are 
sent to an adder-subtracter 102 in which the outputs of the six-axis force sensor Ffsz, 
Mfsx, Mfsy are subtracted therefrom and estimated output errors Fferrz, Mferrx, 
Mferry are calculated. The calculated estimated output errors are outputted directly 
5 on one heind, and on the other hand, are sent to the parameter identifier. The state 

estimator inputs the state variable z(t) and the identified parameters K a, Kb, D 
and calculates the estimated state values h st, 9 stx, 0 sty that are estimated values 
of the aforesaid values hst, 0 stx, 0 sty. 

In this manner, the adaptive observer 100 identifies the parameters (Ka, 
10 Kb, D) used in Eq. 2 and based thereon, calculates the values (that are values 

calculated from Eqs. 3 and 4). In this specification, the value assigned with the hat 
sign indicates that it is an estimated value. 

When the six-axis force sensor 34 operates normally, since the 
parameter identifier identifies the spring constants Ka, Kb and dumping constant D 
15 based on the state variable z(t) (obtained fi-om the inputs) and estimated output 

errors Fferrz, Mferrx, Mferry, if the viscoelastic characteristic of the cylindrical 
rubber members 382 changes with increase or decrease of the environmental 
temperature, the change can be identified. Thus, by regarding the estimated output 
as the estimated floor reaction force, it becomes possible to enhance the detection 
20 accuracy of the floor reaction force of the displacement sensors 70. Further, it 

becomes possible to detect or self-diagnose degradation of the cylindrical rubber 
members 382, etc., by using the parameters identified by the adaptive observer 100. 

FIG. 18 is a flow chart showing the operation mentioned above. The 
program in the figure is also activated at the control unit 26 in every control cycle, 
25 e.g., in every 10 msec. 

The program begins at S200 in which it is determined whether the 
control unit 26 is just powered on, i.e., it is in the very short period after activated by 
power supply, and when the result is affirmative, the program proceeds to S202 in 
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which it is determined whether the cylindrical rubber members 382 is new. Note that 
when the cylindrical rubber members 382 are replaced with new ones, the bit of an 
appropriate flag is to be set to 1 . Here, the determination is performed by referring to 
the bit of the flag. 

When the resuh at S202 is affirmative, the program proceeds to S204 in 
which the parameters (the spring constants Ka, Kb and dimiping constant D) are 
initialized, i.e., the parameters are set to be values that are the values new ones of the 
members 382, i.e., the member 382 not degraded would have. The program then 
proceeds to S206 in which parameter permissible ranges are set. The parameter 
permissible ranges are set as upper and lower limit values that are obtained by 
adding (or subtracting) a predetermined value(s) to (from) the parameters or by 
multiplying a predetermined ratio(s) indicative of permissible changes from the set 
values (or previous values). The bit of the flag (that is set to 1 when the cylindrical 
rubber members 382 were replaced) is reset to 0. 

On the other hand, when the result at S202 is negative, the program 
proceeds to S208 in which the parameter values stored in the backup memory, i.e., 
the last estimated parameter values obtained at previous walking are set as the initial 
parameter values of the adaptive observer. At the same time, the parameter 
permissible ranges (set previously) are again set as the parameter permissible ranges 
for this program loop. 

Then the program proceeds to S210 in which it is determined whether 
the robot 1 is in motion. Here, "in motion" means that the robot motion is under the 
control of displacement of its center of gravity such as walking. When the result at 
S210 is affirmative, the program proceeds to S212 in which it is determined which 
of right and left legs 2 is the supporting leg, and to S214 when the result is the right 
leg, in which calculation at the parameter identifier of the adaptive observer lOOR 
for the right leg is performed. On the other hand, if the result at S212 is the Ipft leg, 
the program proceeds to S216 in which similar calculation at the parameter identifier 
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of the adaptive observer lOOL for the left leg is performed. 

As stated above, the calculation at the parameter identifier (updating of 
the identified constants K a, Kb, D ) is performed within the supporting leg 
period when the robot 1 is in motion. This is because the estimation accuracy of the 
adaptive observer degrades when the input values to the adaptive observer (detected 
value of the displacement sensors 70 and six-axis force sensor 34) are slight. If 
accepting the degradation of the estimation accuracy to some extent, the calculation 
at the parameter identifier may be performed simultaneously for the both legs, 
regardless of whether it is the supporting leg period or fi"ee leg period. It is also 
possible to make a parameter estimation gain smaller, when the input to the adaptive 
observer changes slight, for example, during a free leg period. 

The program then proceeds to S218 in which it is determined whether 
the estimated parameter values, i.e., identified parameters K, D, are within the 
permissible ranges set at S206 or S208, and when the result at S218 is negative, the 
program proceeds to S220 in which it is determined or self-diagnosed that the 
cylindrical rubber members 382, etc., degrade or become abnormal and the robot 
walking is stopped within a short period of time. At the same time the warning light 
is lit and the display device is made on. 

Further, since the cylindrical rubber members 382 degrade gradually (as 
time passes), when the one or all of the identified parameters Ka, Kb, D is not within 
the permissible range(s), taking into account changes in an appropriate past program 
loop (corresponding to "t" in FIG. 17), if it has been found that the change increases 
gradually and has been found not within the permissible range at this program loop, 
it should be determined that the cylindrical rubber members 382 on the 
corresponding leg side has degraded. With that, it becomes possible to achieve more 
accurate abnormality detection. 

On the other hand, since the structure of the six-axis force sensor 34 is 
complicated as mentioned above, once abnormality other than degradation arises. 
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the six-axis force sensor 34 is likely to outputs a value far beyond the permissible 
range immediately. Therefore, when it is determined that the value(s) is not within 
the permissible range in this program loop, despite the fact that change in the 
appropriate past program loop is rather small, it is determined that abnormality such 
as wire disconnection has occurred in the six-axis force sensor 34. In the processing 
at S220, it may be configvired to incorporate the abnormality detection in the second 
or third embodiment in this embodiment and determine taking the result into 
accoimt. 

The program then proceeds to S222 in which observer calculation other 
than that at the parameter identifier is performed for both of the right and left legs. 
When the robot 1 is in motion, the estimated output value, i.e., the floor reaction 
force estimated value based on the outputs of the displacement sensors 70 Ffbz, 
M fbx, M fby are calculated on the basis of the updated identified parameters K sl, 
Kb, D. Contrary, if the robot 1 is not in motion, the observer calculation is 
performed to calculate the estimated floor reaction force Ffl^z, Mfbx, Mft)y, 
without updating the identified parameters, i.e., by using the previous estimated 
values. 

When the aforesaid composite compliance control is performed on the 
basis of the calculated floor reaction force, if the calculated values for the respective 
legs are used immediately, since estimated errors of the parameters may disrupt the 
right-and-left balance of the robot 1, it is preferable to standardize them (make them 
uniform), for instance, by obtaining an average of the calculated values. This will be 
explained in the next embodiment. 

The program proceeds to S224 in which the obtained estimated 
parameter values are stored in the backup memory and the program is terminated. 
This processing may be performed just before power supply is stopped. 

In the eights embodiment, it is thus configured to have the displacement 
sensors 70 disposed in the cylindrical rubber members 382 located at a position 
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between the ankle joint 18, 20 and the floor contact end of the foot 22 and 
generating the outputs indicating the displacement of the floor contact end of the 
foot 22 relative to the ankle joint 18, 20, and the adaptive observer 100 that 
calculates the floor reaction force estimated errors Fferrx, Mferrx, Mferry indicative 
of errors between the floor reaction force components F fbz, M fl^x, M fl^y 
estimated from the outputs of the displacement sensors 70 and the floor reaction 
force detected from the output of the six-axis force sensor 34, based on the outputs h, 
9x, 9y of the displacement sensors 70 and the detected floor reaction force 
components Ffsz, Mfsx, Mfsy, and identifies the model's parameter values Ka, Kb, 
D. Therefore, When installing the six-axis force sensor 34 at the foot 22 of the robot 
1 to detect the floor reaction force and in addition, when installing the displacement 
sensors 70 (utilizing the viscoelastic characteristic) at the foot 22 to calculate or 
estimate the floor reaction force, it becomes possible to estimate change in the 
viscoelastic characteristic due to temperature drift or degradation of the cylindrical 
rubber members 382, without disposing a temperature sensor, thereby enabling to 
enhance the detection accuracy. 

Further, it is configured to self-diagnose degradation of the cylindrical 
rubber members 382 and six-axis force sensor 34 or abnormality of the six-axis 
force sensor 34, it becomes possible to further enhance the detection accuracy. 

It should be noted that, in the processing at S218, it is alternatively 
possible to calculate and store temperature characteristic of the parameters Ka, Kb, 
D of the cylindrical rubber members 382 in advance, and to determine whether the 
estimated parameter values are within the permissible ranges with taking that into 
account. In other words, if the temperature at the cylindrical rubber member itself or 
of its edge is measured and if the permissible ranges are adjusted for the measured 
temperature, and if it is determined whether the estimated parameter values are 
within the adjusted permissible ranges, it becomes possible to fiirther enhance the 
degradation or abnormality detection accuracy. 
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It should be also noted that, aside from determining whether the 
estimated parameter values are within the permissible ranges, the estimated 
parameter values for each leg may be compared with each other in order to 
determine the degree of difference in the right and left legs. In that case, although 
the degradation can be determined without being affected by the temperature 
dependency of the cylindrical rubber members 382, since it is not possible to judge 
whether the degradation at the right and left legs are same extent, it is only a 
subsidiary method. 

It should be also noted that, although the adaptive observers 100 are 
installed at each of the right and left legs, i.e., at the respective feet 22 as the 
adaptive observer lOOR for the right leg and adaptive observer lOOL for the left leg, 
since the calculations are the same as mentioned above, it is possible to install only 
one adaptive observer for all the legs (feet 22) and to select values to be inputted to 
the adaptive observer 100 from those of the right or left leg, based on the 
determination at S212, for instance. 

FIG. 19 is an explanatory view showing the configuration of a legged 
mobile robot and a floor reaction force detection system according to a ninth 
embodiment of the invention. 

The ninth embodiment is an alteration of the eighth embodiment. It is 
configured in this embodiment that the estimated parameter values of the respective 
parameter identifier in the adaptive observers lOOR, lOOL are made common at a 
parameter-standardizing processing block 104. The estimated output errors for the 
respective legs are calculated based on the standardized estimated parameter values. 

Explaining this with reference to Fig. 20, changed amounts of the 
estimated parameter value outputted from the parameter identifier in the adaptive 
observer lOOR (i.e., differences between the present and previous values) AKaR, 
AKbR, ADR and those in the adaptive observer lOOL AKaL, AKbL, ADL are 
inputted to the parameter-standardizing processing block 104. 
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In the parameter-standardizing processing block 104, weight-averages of 
the output (a may be set to 0.5 for obtaining simple averages) AKaave, AKbave, 
A Dave are obtained and added to the previous estimated parameter values in order 
to determine the current estimated parameter values (updated values) K a, Kb, D . 
At the same time, it sends the determined values K a, Kb, D to each of the 
right/left adaptive observers lOOR, lOOL. 

In the left and right adaptive observers lOOR, lOOL, the estimated floor 
reaction force of each leg is calculated based on these standardized estimated 
parameter values, and based thereon, the estimated output errors are calculated. The 
estimated parameter values are thus standardized, thereby enabling to avoid robot 
walking from falling unstable due to the differences between the right and left 
parameters. 

In calculating the weight-averages, it is preferable to set the weight for 
the supporting leg larger than that for the free leg (i.e., a is set greater when the 
right leg is free, and smaller when the left leg is free). This is because changes in 
inputs to the adaptive observer are slight during the free leg period and accordingly 
the detection accuracy degrades as mentioned above. 

Having been configured in the foregoing manner, in the ninth 
embodiment, despite the fact that the structure of this embodiment is slightly 
complicated compared to the eighth embodiment, it becomes possible to enhance the 
estimation accuracy and the self-diagnosis accuracy for the respective legs. The rest 
of the structure and effect is the same as that of the eighth embodiment. 

As stated above, the first to ninth embodiments are configured such that, 
in a legged mobile robot 1 having at least a body 24 and a plurality of legs 2 each 
connected to the body through a first joint (hip joints 10, 12, 14), and each having a 
foot 22 connected to a distal end of the leg through a second joint (ankle joints 18, 
20), there are provided with an elastic member (cylindrical rubber member 382) at a 
position between the second joint and a floor contact end of the foot, a displacement 



43 



sensor 70 having the sensing element and the converter in a space defined by 
top-to-bottom height ht of the elastic member such that a displacement of the floor 
contact end of the foot relative to the second joint h (Ln) can be detected. 

Further, it is configured such that a plurality of (three or four) the elastic 
members (cylindrical rubber members 382) are installed at the position between the 
second joint and the floor contact end of the foot, at separate locations when viewed 
from top. 

Further, it is configured in the first embodiment, etc., such that the 
displacement sensors 70 are each housed in the elastic members (cylindrical rubber 
members 382) such that the displacement of the floor contact end of the foot relative 
to the second joint can be detected. 

Furthermore, it is configured in the sixth embodiment, such that the 
displacement sensors, more specifically the displacement sensors 70 are each 
installed in the vicinity of the elastic members (cylindrical rubber members 382) 
such that the displacement of the floor contact end of the foot relative to the second 
joint can be detected. 

Further, it is configured such that a plurality of the elastic members 
(cylindrical rubber members 382) are located at the edge of the foot 22 when viewed 
from top. 

Further, it is configured such that the displacement sensor 70 is housed 
in a sealed space. 

Further, it is configured such that each of the displacement sensors 70 
comprises a spring (spring 703) and a pressure-sensitivity sensor 701. 

Further, it is configured such that rigidity of the spring 703 is set to be 
lower than that of each of the elastic members (cylindrical rubber members 382). 

Further, it is configured such that, in a legged mobile robot 1 having at 
least a body 24 and a plurality of legs 2 each connected to the body through a first 
joint (hip joints 10, 12, 14), and each having a foot 22 connected to a distal end of 
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the leg through a second joint (ankle joints 18, 20), there are provided with a 
pluiality of displacement sensors 70 in a space defined by a first rigid member 
(inverted-Q-like frame 381) connected to the second joint and a second rigid 
member (sole frame 50) connected to a floor contact end of the foot at locations 
spaced apart with each other when viewed from top that produces outputs indicative 
of a displacement of the floor contact end of the foot relative to the second joint h 
(Ln), a discriminator (control unit 26, SI 2) that discriminates whether the outputs Ln 
of the displacement sensors satisfy a predetermined geometric relationship, and a 
self-diagnoser (control unit 26, SI 4) that self-diagnoses whether at least one of the 
displacement sensors is abnormal. 

Further, it is configured such that the geometric relationship is a 
relationship in which a difference between the outputs of the displacement sensors 
located at opposite positions is a predetermined value. 

Further, it is configured such that the predetermined value is zero or a 
value close thereto. 

Further, it is configured such that a plurality of the elastic members 
(cylindrical rubber members 382) are installed in the space defined by the first and 
second rigid members at separate locations in top view, and the displacement 
sensors 70 are each housed in the elastic members. 

Further, it is configured such that a plurality of the elastic members 
(cylindrical rubber members 382) are installed in the space defined by the first and 
second rigid members at separate locations in top view, and the displacement 
sensors 70 are installed in the vicinity of the elastic members. 

Further, it is configured in the third embodiment such that, in a floor 
reaction force detection system of a legged mobile robot 1 having at least a body 24 
and a plurality of legs 2 each connected to the body through a first joint (hip joints 
10, 12, 14), and each having a foot 22 connected to a distal end of the leg through a 
second joint (ankle joints 18, 20), there are provided with a displacement sensor 70 
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in or in the vicinity of an elastic member (cylindrical rubber member 382) 
positioned between the second joint and a floor contact end of the foot that produces 
output indicative of a displacement of the floor contact end of the foot relative to the 
second joint h (Ln), and a floor reaction force calculator (control unit 26) that 
calculates the floor reaction forces Ffbz, MAdx, Mfby acting on the foot based on the 
output of the displacement sensors by using a model that describes a relationship 
between the displacement h (Ln) and stress Fn generated in the elastic members in 
response to the aforesaid displacement. 

Further, it is configured such that the model is described by a first spring 
(spring having the spring constant Kb shown in FIG. 6), a dumper (dumper having 
the dumping constant D) arranged in series with the first spring and a second spring 
(spring having the spring constant Ka) arranged in parallel with the first spring and 
dumper. 

Further, it is configured such that the floor reaction force calculator 
includes an observer 90 that estimates the floor reaction force by estimating 
displacement Xn of the dumper. 

Further, it is configured such that the floor reaction force calculated by 
the floor reaction force calculator includes at least the force component Ffbz acting 
in the vertical-axis direction. 

Further, it is configured such that a plurality of the displacement sensors 
are located to be apart fi-om each other (locally) when viewed from top and the floor 
reaction force calculator calculates the floor reaction force on the basis of the 
outputs of the respective plural displacement sensors,. 

Furthermore, it is configured such that the floor reaction force calculated 
by the floor reaction force calculator includes the force component Ffl^z acting in the 
vertical-axis direction and the moment components Mfbx, Mfby acting about the 
axis that orthogonally intersects the vertical-axis. 

Further, it is configured to have a second floor reaction force detector 
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(six-axis force sensor 34) installed at a position between the second joint (ankle joint 
18, 20) and the contact end of the foot that generates the outputs indicating floor 
reaction forces Ffsx, Mfsx, Mfsy acting on the foot from the floor surface which the 
robot 1 contacts. 

Furthermore, it is configured to have a self-diagnoser (control unit 26, 
SI 00 to SI 22) that self-diagnoses whether abnormality or degradation occurs in at 
least one of the displacement sensors 70 or the floor reaction force detector based on 
the floor reaction forces FAdz, Mfl^x, Mfby calculated by the floor reaction force 
calculator and the floor reaction forces Ffsz, Mfsx, Mfsy detected from the outputs 
of the second floor reaction force detector. 

Further, it is configured such that the self-diagnoser includes a first 
determiner (control unit 26, SI 08 to SI 12) that determines whether at least one of 
differences or ratios between the floor reaction forces calculated by the floor 
reaction force calculator and that detected from the outputs of the second floor 
reaction force detector, more specifically errors Fferrz, Mferrx, Mferry, are within a 
first predetermined range, and self-diagnoses that at least one of the displacement 
sensors, the second floor reaction force detector and the elastic members degrades 
when it is determined that at least one of the differences or ratios are not within the 
first determined range (control unit 26, SI 08 to SI 12). 

Further, it is configured such that the self-diagnoser includes a second 
determiner (control unit 26, SI 14 to SI 18) that determines whether at least one of 
the differences or ratios between the floor reaction forces calculated by the floor 
reaction force calculator and that detected from the outputs of the second floor 
reaction force detector, more specifically errors Fferrz, Mferrx, Mferry, are within a 
second predetermined range, and self-diagnoses that the second floor reaction force 
detector is abnormal when it is determined that at least one of the differences or 
ratios are not within the second determined range (control unit 26, SI 20, SI 22). 

Fiirthermore, it is configured such that the self-diagnoser includes a 



47 



counter (control unit 26, SI 08) that counts the number of times that it is determined 
that one of the differences or ratios are not within the first predetermined range, and 
self-diagnoses that at least one of the displacement sensors, the floor reaction force 
detector and the elastic members degrades when the counted number of times (count 
value C) exceeds a predetermined number of times (predetermined value Cref) 
(control unit 26, SI 10 to SI 12). 

It is configured in the eighth and ninth embodiments such that, in a floor 
reaction force detection system of a legged mobile robot 1 having at least a body 24 
and a plurality of legs 2 each connected to the body through a first joint (hip joints 
10, 12, 14), and each having a foot 22 connected to a distal end of the leg through a 
second joint (ankle joints 18, 20), there are provided with a plurality of displacement 
sensors 70 in or near an elastic member (cylindrical rubber member 382) positioned 
between the second joint and the floor contact end of the foot that produces outputs 
indicative of a displacement of the floor contact end of the foot relative to the 
second joint h (Ln), and a floor reaction force detector (six-axis force sensor 34) 
installed at a position between the second joint and the floor contact end of the foot 
that generates outputs indicating floor reaction forces Ffsz, Mfsx, Mfsy acting on the 
foot from the floor surface which the robot contacts; and the adaptive observer 100 
(more specifically estimator having the adaptive observer 100 (control unit 26, S200 
to S224) that outputs floor reaction force estimated errors Fferrz, Mferrx, Mferry 
indicating errors between floor reaction forces F fbz, M fbx, M fby estimated 
from the displacement sensors and floor reaction forces Ffsz, Mfsx, Mfsy detected 
from the outputs of the floor reaction force detector by using a model describing a 
relationship between the displacement h (Ln) and stress Fn of the elastic members 
generated in response to the aforesaid displacement, on the basis of the outputs h. 
Ox, 0y of the displacement sensors and the floor reaction forces Ffsz, Mfsx, Mfsy 
detected from the outputs of the floor reaction force detector, and identifies the 
model's parameter values Ka,.Kb, D. 
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Further, it is configured to have an elastic member self-diagnoser 
(control unit 26, S218) that self-diagnoses degradation of the elastic members based 
on the parameter values K a, Kb, D . 

Furthermore, it is configured such that the adaptive observer 100 is 
installed for each foot 22, i.e., each of the right and left feet (i.e., the adaptive 
observer IGOR and lOOL), separately. 

Further, it is configured such that the adaptive observer 100 is installed 
one for all of the feet 22, i.e., the two feet 22. 

Further, it is configured such that the parameter values Ka, Kb, D, 

^ /\ /\ 

specifically parameter values K a + A Kaave, K b + A Kbave, D + A Dave 

standardized at a parameter-standardizing processing block 104 are used in the 

plural adaptive observers lOOR, lOOL in common. 

Further, it is configured to have a floor reaction force detector 

self-diagnoser (control unit 26, SI 02 to SI 22) that self-diagnoses abnormality in the 

floor reaction force detector based on the floor reaction force estimated errors Fferrz, 

Mferrx, Mferry. 

Further, it is configured such that the model approximates the 
viscoelastic characteristic of the elastic members by springs (spring constants Ka, 
Kb) and a dumper (dumper constant D), and the parameter values are made of the 
spring constants Ka, Kb and dumper constant D. 

It should be noted that, although the pressure-sensitivity sensor of 
electrostatic type is used in the displacement sensors in the above, the invention 
should not be limited thereto. It is alternatively possible to use other sensors of a 
piezoelectric, strain gage or eddy-current type. 

It should further be noted that, although the invention has been described 
with reference to a biped mobile robot in the above, the invention can also be 
applied to any other legged mobile robots having legs of three or more. 
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INDUSTRIAL FIELD IN WHICH THE INVENTION IS APPLICABLE 

According to the invention, it is arranged to provide a legged mobile 
robot, in which an elastic member is installed at a position between a second joint 
connecting a distal end of a leg and a foot and a floor contact end of the foot, and a 
displacement sensor is installed in a space defined by a top-to-bottom height of the 
elastic member. With this, it becomes possible to make the displacement sensor 
including its components such as the converter or the like enough compact to be 
housed in the elastic member at the limited space of the foot of the legged mobile 
robot. Further, it is arranged to self-diagnose abnormality of the displacement sensor 
by utilizing the redundancy thereof, and to detect the floor reaction force accurately 
to achieve more stable walking of the legged mobile robot. The invention can thus 
apply to the legged mobile robot or the like. 



50 



